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@ Verfahren und Vorrichtung zur Regelung der Vorhatteposition eines Manipulators eines Handhabungsgerats 

(57) Die Erfindung betrifft ein Verfahren zur Regelung der 
Vorhalteposition eines in mehreren Freiheitsgraden be- 
wegbaren Manipulators (2) eines Handhabungsgerats (1) 
relativ zu einem Objekt (3) entlang einer Verfahrbahn. Um 
eine schnellere Regelung der Vorhalteposition zu ermog- 
lichen, wird vorgeschlagen, dass mehrere Punkte zumln- 
dest eines Teils der !st-Verfahrbahn gespeichert sind und 
fur eine vorausschauende Regelung der Vorhalteposition 
des Manipulators (2) entlang dieses Teils der Verfahrbahn 
herangezogen werden. 
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Beschreibung 

Die vorliegende Erfindung betrifft ein Verfahren und eine 
Vorrichtung zur Regelung der Vorhalteposition eines in 
mehreren Freiheiisgraden bewegbarcn Manipulators eines 
Handhabungsgerats relaiiv zu einem Objekt enilang einer 
Verfahrbahn. Die Erfindung beuifft auBerdeni ein Handha- 
bungsgerat mit einem in mehreren Freiheiisgraden beweg- 
barcn Manipulator, dessen Vorhalteposition relativ zu einem 
Objekl regelbar isl. 

Das Handhabungsgerat ist bspw. als ein mehrgelenkiger 
Induslrie-Roboter ausgebildet. Derartige Industrie-Roboler 
werden insbesondere in der Automobilindustrie in der Ferti- 
gung und der Qualilatssicherung eingesetzl. Fiir die unter- 
schiedlichen Einsaizmoglichkeiten eines Indusuie-Roboters 
kann der Manipulator beliebig ausgebildet sein. 

Der Manipulator ist bspw. als ein Werkzeug, insbesondere 
als ein SchweiBgerat, als ein Gerat zum Aufu-agen von 
Klebstoff, von Farbe oder von anderen Beschichtungen auf 
eine Oberflache, als ein Bearbeitungsgerat o. a. ausgebildet. 
Zum Ergreifen eines oder mehrerer Objekte kann der Mani- 
pulator als ein Greifer, ein Saugnapf o. a. ausgebildet sein. 
SchlieBlich ist es denkbar, dass der Manipulator als ein 
Messkopf z. B. zum Messen des Oberflachenverlaufs eines 
Objekts, einer Spaltbreite, eines Spaltversalzes, einer 
Schichtdicke o. a. ausgebildet ist. 

Damit der Manipulator die ihm zugedachte Aufgabe er- 
fiillen kann, muss er in eine definierle Vorhalteposition rela- 
tiv zu einem Objekt gebracht werden. Unter dem Begriff 
Vorhalteposition wird gemaB dem vorliegenden Patent so- 
wohl die Positionierung als auch die Ausrichtung des Mani- 
pulators relativ zu dem Objekt verstanden. 

Aus dem Stand der Technik sind Handhabungsgerate be- 
kannt, die eine interne Steuerungseinrichtung aufweisen. 
Auf der Steuerungseinrichtung ist ein Steuerungsprogramm 
laufFahig, durch das der Manipulator entlang einer program- 
mierten Verfahrbahn in die Vorhalteposition bewegt werden 
kann. Wenn das Objekt stets an derselben Position angeord- 
net ist, reicht eine solche Steuerung der Verfahrbahn bis zur 
Vorhalteposition vollkommen aus. Falls die Position des 
Objekts jedoch gewissen Schwankungen unterworfen ist, 
was der Regelfall ist, kann durch eine Steuerung alleine 
nicht mehr sichergestellt werden, dass eine bestimmte Vor- 
halteposition des Manipulators relativ zu dem Objekt stets 
mit der erforderlichen Genauigkeit eingenommen wird. 
Schwankungen der Position des Objekts konnen vielerlei 
Ursachen haben. 

Um sicherzuslellen, dass die Vorhalteposition des Mani- 
pulators relativ zu dem Objekt auch bei Schwankungen der 
Position des Objekts stets mit der geforderten Genauigkeit 
eingenommen wird, isl es aus dem Stand der Technik eben- 
falls bekannt, die Vorhalteposition des Manipulators relativ 
zu dem Objekt zu regeln. Aus dem Stand der Tfechnik sind 
unterschiedliche Verfahren zur Regelung der Vorhaltepos- 
ition des Manipulators bekannt. Diese bekannten Verfahren 
zur Regelung der Vorhalteposition sind jedoch sehr kompli- 
zien und langsam. 

Im Rahmen der Regelung der Vorhalteposition des Mani- 
pulators relativ zu einem Objekt wird die Ist- Vorhaltepos- 
ition des Manipulators zunachst mittels Sensoren erfassl und 
dann auf eine Soil- Vorhalteposition geregelt. Die Sensoren 
sind bspw. als optische oder als taktile Sensoren ausgebildet. 

Insbesondere sind sie als Laser-Sensoren zum Messen 
von Abstanden, als Krafl/Momenlen-Sensoren zum Messen 
von Kraften bzw. Momenten oder als Beriihrungssensoren 
zur Detektion einer Beriihrung mit dem Objekl ausgebildet 

Die Sensoren sind in einem bestimmlen Bezug (Position 
und Ausrichtung) zu dem Manipulator angeordnet. \for der 



Regelung der Vorhalteposition miissen die Sensoren in ei- 
nen konkreten Bezug zu dem Manipulator und zu dem Ob- 
jekt gebracht werden (Einrichten) und die Parameter der Re- 
gelung an den konkreten Bezug angepasst werden (Kalibrie- 

5 ren), Der Bezug der Sensoren zu dem Manipulator kann sich 
aufgrund von Temperaturschwankungen, mechanischen 
Einwirkungen auf die Sensoren oder den Manipulator, o. a. 
verandem, wodurch ein emeutes Kalibrieren und u. U. sogar 
eine emeuies Einrichten der Vorrichtung zur Durchfuhrung 

10 der Regelung nolwendig wird. Wahrend des Einrichtens und 
Kalibrierens steht die Vorrichtung nicht fiir eine Regelung 
zur Verfugung, die Regelung der Vorhalteposition muss un- 
lerbrochen werden. 
Samtliche bekannten Verfahren zur Regelung der Vorhalt- 

15 eposition des Manipulators haben auBerdem den Nachteil, 
dass die Verfahrgeschwindigkeit des Manipulators relativ 
klein isl, da die Regelung in Unkennlnis der bevorslehen- 
den, zu regelnden Verfahrbahn des Manipulators erfolgl. 
Deshalb muss die Verfahrgeschwindigkeit so klein gewahlt 

20 werden, dass auch im Extremfall einer Verfahrrichtungsum- 
kehr eine rasche und genau Positionierung des Manipulators 
sichergestellt werden kann. Bei einer zu hohen Verfahrge- 
schwindigkeit wurde der Manipulator bei stark gekriimmten 
Verfahrbahnen oder einer Verfahrrichtungsumkehr aufgrund 

25 der Massentragheit iiber die geregelle Verfahrbahn hinaus- 
schieBen und somit die geregelle Verfahrbahn verlassen. 

Es ist deshalb eine Aufgabe der vorliegenden Erfindung, 
ein Verfahren der eingangs genannten Art dahingehend aus- 
zugestallen und weiterzubilden, dass eine moglichst 

30 schnelle Regelung der Vorhalteposition erreichl und dass 
insbesondere hohere Verfahrgeschwindigkeiten des Mani- 
pulators auf der Verfahrbahn realisiert werden konnen, ohne 
dass es zu einem Verlust an Regelungsgenauigkeit kommt. 
Zur Losung dieser Aufgabe schlagt die Erfindung ausge- 

35 hend von dem Verfahren der eingangs genannten Art vor, 
dass mehrere Punkle zumindest eines Teils der Ist- Verfahr- 
bahn gespeichert sind und fiir eine vorausschauende Rege- 
lung der Vorhalteposition des Manipulators entlang dieses 
Teils der Verfahrbahn herangezogen werden. 

40 ErfindungsgemaB ist erkannt worden, dass die Regelung 
der Vorhalteposition durch eine vorausschauende Regelung 
auf einfache Weise entscheidend beschleunigt werden kann. 
Wahrend der vorausschauenden Regelung der Vorhaltepos- 
ition wird der bevorstehende Verlauf der Verfahrbahn be- 

45 riicksichtigt. Wenn der bevorstehende Verlauf der Verfahr- 
bahn es zulassl, bspw. bei einer geraden oder einer nur ge- 
ringfiigig gekriimmten Verfahrbahn, kann die Verfahrge- 
schwindigkeit des Manipulators hoch gewahlt werden. Da- 
durch kann die Regelung der Vorhalteposition entlang einer 

50 Verfahrbahn entscheidend beschleunigt werden. Bei zuneh- 
mender Kriimmung der bevorstehenden Verfahrbahn muss 
die Verfahrgeschwindigkeit zunehmend reduzierl werden. 
Durch die Wahl einer geringen Verfahrgeschwindigkeit bei 
starken Kriimmungen der bevorstehenden Verfahrbahn kann 

55 zudem die Genauigkeit der Regelung der Vorhalteposition 
des Manipulators entlang der Verfahrbahn entscheidend er- 
hoht werden. Bei dem erfindungsgemaBen Verfahren kann 
die Verfahrgeschwindigkeit somit dem Verlauf der bevorste- 
henden Verfahrbahn individuell angepasst werden. 

60 Die Punkle der Ist- Verfahrbahn konnen auf unterschiedli- 
che Weise, z. B. empirisch, simulaliv oder durch Berech- 
nung, bestimml werden. Bei der empirischen Bestimmung 
der Punkle der Ist- Verfahrbahn konnen die einzelnen Punkle 
entweder mit dem Manipulator des Handhabungsgerats ma- 

65 nuell oder von einer ersten Steuereinrichtung gesteuert an- 
gefahren werden. Bei der simulativen Bestimmung der 
Punkle wird zunachst ein Modell des Handhabungsgerats 
und des Objekts, vorzugsweise auf einem Computer, er- 
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stellt. Anhand dieses Modells wird dann durch Simulation 
der Verfahrbahn die Ist-Verfahrbahn besiimmi. Bei der ma- 
thematischen Berechnung der Punkte der Isi- Verfahrbahn 
wird zunachst ein maihematisches Modell des Handha- 
bungsgerats und des Objekts erslellt, und die Punkte werden 
dann durch Losen malhematischer Gleichungen berechnel. 

GemaB einer vorleilhaften Weilerbildung der vorliegen- 
den Erfindung wird vorgeschlagen, dass die Isl- Verfahrbahn 
des Manipulators vor der Regelung der Vorhalteposition ab- 
gefahren wird und dabei die Punkte zumindesl eines Tfeils 
der Ist-Verfahrbahn aufgenommen und abgespeichert wer- 
den. Die Ist-Verfahrbahn muss nicht mit besonders hohen 
Anforderungen an die Genauigkeit abgefahren werden, da 
die Verfahrbahn im Rahmen der nachfolgenden Regelung 
der Verfahrbahn des Manipulators korrigiert werden kann. 
Die abgefahrene Ist-Verfahrbahn stellt lediglich eine Ab- 
schatzung des Verlaufs der Soil- Verfahrbahn dar und muss 
so genau sein, dass sie fur eine vorausschauende Regelung 
der Vorhalteposition des Manipulators entlang der Verfahr- 
bahn herangezogen werden kann. 

Die Ist-Verfahrbahn wird vorteilhafterweise von dem Ma- 
nipulator- vor der Regelung der Vorhalteposition von einer 
intemen Steuerungseinrichtung des Handhabungsgerats ge- 
steuert abgefahren. Auf der intemen Steuerungseinrichtung 
lauft ein Steuerungsprogramm ab, in dem die einzelnen 
Punkte der Ist-Verfahrbahn programmiert sind. Das Steue- 
rungsprogramm steuert das Handhabungsgerat derart an, 
dass der Manipulator wahrend des Ablaufs des Steuerungs- 
programms die Ist-Verfahrbahn abfahrt. Dabei werden die 
Punkte zumindest eines Teils der Ist-Verfahrbahn aufge- 
nommen und abgespeichert. Au&er den in dem Steuerungs- 
programm programmierlen Punkten der Ist-Verfahrbahn 
konnen noch zusatzliche Punkte der Ist-Verfahrbahn aufge- 
nonunen und gespeichert werden. 

Die Punkte zumindest eines Teils der Ist-Verfahrbahn 
werden vorzugsweise von einer extemen Regelungseinrich- 
tung aufgenommen und abgespeichert. Auf der extemen Re- 
gelungseinrichtung lauft ein Regelungsprogramm ab, das 
die Vorhalteposition des Manipulators auf der Verfahrbahn 
regell. Die exteme Regelungseinrichtung ist bspw. als ein 
Personal Computer (PC) oder als ein IndusUne-PC ausgebil- 
det. Das Regelungsprogramm kann in einer Standard-Pro- 
grammiersprache programmiert und ohne groBen Aufwand 
umprogrammiert werden. In einem bestimmten Modus (Re- 
cord-Mode) vor der Regelung der Vorhalteposition kann das 
Regelungsprogramm auch die Punkte der von dem Manipu- 
lator abgefahrenen Ist-Verfahrbahn aufnehmen und abspei- 
chem. Die gespeicherten Punkte werden dann in einem an- 
deren Modus (Operation-Mode) fiir die vorausschauende 
Regelung der Vorhalteposition herangezogen. 

GemaB einer anderen vorleilhaften Weilerbildung der 
vorliegenden Erfindung wird vorgeschlagen, dass die ex- 
teme Regelungseinrichtung von der intemen Steuerungsein- 
richtung aufgerufen wird. Das Steuemngsprogramm der in- 
temen Steuerungseinrichtung isl ublicherweise in einer pro- 
prietaren, nur auf der Steuerungseinrichtung eines bestimm- 
ten Handhabungsgerats lauffahigen Programmierungsspra- 
che programmiert. Es ware nur mit einem groBen Aufwand 
moglich, das gesamte Regelungsprogramm in das Steue- 
mngsprogramm zu integrieren. Deshalb sind in dem Steue- 
mngsprogramm bestimmte Programmierbefehle (Aufmfbe- 
fehle, Riickholbefehle) vorgesehen, um das Regelungspro- 
gramm der extemen Regelungseinrichtung von dem Steue- 
mngsprogramm aus aufzumfen. Das Einfugen dieser Pro- 
granunierbefehle in das Steuemngsprogramm ist mil einem 
geringen Aufwand moglich, Je nach dem in welchem Mo- 
dus die Regelung betrieben wird, werden durch einen Auf- 
mf des Regelungsprogramms der Regelungseinrichtung die 
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Punkte der Ist-Verfahrbahn aufgenommen und gespeichert 
(Record-Mode) oder die Vorhalteposition vorausschauend 
geregeli (Operation-Mode), 
In einer anderen vorleilhaften Weilerbildung der Erfin- 

5 dung wird vorgeschlagen, dass vor der Regelung der Vor- 
halteposition die Soil- Vorhalteposition des Manipulators an- 
gefahren wird, wahrend einer Verandemng der Soil- Vorhalt- 
eposition um jeweils einen Freiheitsgrad Messdaten, durch 
die die Vorhalteposition des Manipulators charakterisiert ist, 

10 aufgenommen und gespeichert werden und die Regelung 
der Vorhalteposition in Abhangigkeii von den Messdaten 
durchgefiihrt wird. Zwischen den aufgenonunenen Messda- 
ten und der Position des Manipulators besteht ein Zusam- 
menhang. Somit sind in den aufgenonmienen Messdaten In- 

15 formationen iiber die Position des Manipulators enthalten. 
Die Soil- Vorhalteposition wird in einem weiteren Modus 
(Parameter-Mode) vor der Regelung der Vorhalteposition 
angefahren. Zum Anfahren der Soil- Vorhalteposition im Pa- 
rameter-Mode werden die im Record-Mode gespeicherten 

20 Punkte der Ist-Verfahrbahn herangezogen. Sobald die SoU- 
Vorhalleposition erreichl ist, beginni eine Trainingsphase, in 
der fur die spatere, im Rahmen des Operation-Mode durch- 
gefuhrte Regelung der Vorhalteposition benotigle Informa- 
tionen ermittelt werden. 

25 Wahrend der Trainingsphase wird der Manipulator um 
die Soil- Vorhalteposition um jeweils einen Freiheitsgrad in 
unlerschiedliche Nforhaltepositionen relativ zu dem Objekt 
bewegt. Der Manipulator wird um jeden Freiheitsgrad in 
Vorhaltepositionen bewegt, die vorzugsweise zu beiden Sei- 

30 len der Soil- Vorhalteposition liegen. Die Vorhaltepositionen 
des Manipulators werden durch Sensoren ermittelt, die vor- 
zugsweise an dem Manipulator befestigl sind. Die Sensoren 
liefem Messdaten anhand derer eine Vorhalteposition des 
Manipulators charakterisiert ist. Die Messdaten sind bspw, 

35 die Abstande von den Sensoren zu dem Objekt, Krafte oder 
Momenle, die von dem Objekt auf die Sensoren einwirken. 
Die Messdaten konnen auch Bildmessdaten sein. Bildmess- 
daten werden durch Vermessen von Bildem gewonnen, die 
von einer CCD-Kamera o. a. aufgenommen wurden. Im 

40 Rahmen der Trainingsphase werden die Messdaten fiir jeden 
der Freiheitsgrade fiir jede der Vorhaltepositionen aufge- 
nommen. Es isl denkbar, dass die gespeicherten Messdaten 
fiir die Regelung der Vorhalteposition weiierverarbeitet wer- 
den. Dann ist die Trainingsphase fiir diese Soll-Vorhallepos- 

45 iiion abgeschlossen. Der Manipulator kann eine weitere 
Soil- Vorhalteposition anfahren und fur diese Soil- Vorhalt- 
eposition eine weitere Trainingsphase durchlaufen, bis alle 
Soil- Vorhaltepositionen angefahren worden sind. Dann ist 
der Parameter-Mode abgeschlossen. Die spatere, im Rah- 

50 men des Operation-Mode durchgefuhrte Regelung der Vor- 
halteposition wird in Abhangigkeii von den gespeicherten 
Messdaten durchgefuhrt. 

Bei dem erfindungsgemaBen Verfahren ersetzt die Trai- 
ningsphase das bei herkonunlichen, aus dem Stand der 

55 Technik bekannten Verfahren zum Regeln der Vorhaltepos- 
ition des Manipulators eines Handhabungsgerats notwen- 
dige Einrichten (Positionierung der Sensoren relativ zu dem 
Objekt) und Kalibrieren (Einstellen der Parameter der Rege- 
lung). 

60 Auch bei diesem Verfahren, bei dem vor der Regelung der 
\ferhalteposilion eine Trainingsphase durchlaufen wird, 
werden mehrere Punkte zumindest eines Teils der Ist-Ver- 
fahrbahn gespeichert und fur eine vorausschauende Rege- 
lung der Vorhalteposition des Manipulators entlang dieses 

65 Teils der Verfahrbahn herangezogen. Das Durchlaufen einer 
Trainingsphase vor der Regelung der Vorhalteposition hat 
die angegebenen Vorteile aber auch ohne diese Merkmale 
des Kennzeichens des Paientanspmchs L Der Schutz des 



Patents soil sich deshaib auch auf ein Verfahren der zuletzt 
genannten Art beziehen, bei dem die im Kennzeichen des 
Patentanspruchs 1 genannten Merkmale fehlen. 

GemaB einer bevorzugten Ausfiihrungsfonn der vorlie- 
genden Erfindung wird vorgeschlagen, dass vor der Rege- 
lung der Vorhalteposition 

- die Soil- Vorhalteposition angefahren wird, 

- ein SoU-Messvektor mit den Messdaten aufgenom- 
men wird, 

- fiir jeden Freiheitsgrad der Manipulator des Handha- 
bungsgerats aus der Soil- Vorhalteposition heraus in 
mehrere Vorhaltepositionen bewegt und in jeder Vor- 
halteposition ein Messvektor aufgenonunen wird, 

- fiir jeden Freiheitsgrad fur dieselben Messdaten der 
Messvektoren der Belrag des Gradienten ermittelt und 
in einer Gradientenmatrix gespeichert wird, und im 
Rahmen der Regelung der Vorhalteposition 

- ein Korrekturvektor aus der Multiplikation des 
Kehrwerts der Gradientenmatrix mit der Differenz des 
Soll-Messvektors und eines Ist-Messveklors in der Ist- 
Vorhalteposition des Manipulators oder anhand eines 
anderen geeigneten Verfahrens ermittelt wird und 

- die Vorhalteposition in Abhangigkeit von dem Kor- 
rekturvektor geregelt wird. 

GemaB dieser bevorzugten Ausftihrungsform werden in 
der Training sphase im Parameter-Mode die fiir die Soli- Vor- 
halteposition aufgenommenen Messdaten in einem Soll- 
Messvektor und die Messdaten, die fiir im Rahmen der Trai- 
ningsphase angefahrene Vorhaltepositionen aufgenommen 
wurden, in Messvektoren gespeichert. Fiir jeden Freiheits- 
grad, um den der Manipulator bewegbar ist, werden also von 
der Soli- Vorhalteposition aus mehrere Vorhaltepositionen in 
jede Richtung angefahren und in jeder Vorhalteposition ein 
Messvektor aufgenommen. Die Dimension der Messvekto- 
ren entspricht der Anzahl der fiir jede Vorhalteposition auf- 
genonmienen Messdaten. Die Dimension aller Messvekto- 
ren ist gleich groB. 

Fur jeden Freiheitsgrad werden die Messvektoren und der 
Soll-Messvektor dann weiterverarbeitet. Aus denselben 
Messdaten der Messvektoren eines Freiheitsgrades wird der 
BeU-ag des Gradienten ermittelt und in einer Gradientenma- 
trix gespeichert. Die Gradientenmauix hat somitdie Dimen- 
sionen (Anzahl der fur jede Vorhalteposition aufgenomme- 
nen Messdaten) x (Anzahl der Freiheitsgrade). Es ist denk- 
bar, den Kehrwert der Gradientenmatrix bereits in dem Pa- 
rameter-Mode zu berechnen und abzuspeichem. Vorzugs- 
weise wird er aber erst in dem nachfolgenden Operation- 
Mode berechnet. Damit ist die Trainingsphase fiir diese 
Soll-Vorhalteposidon abgeschlossen. Die Gradientenmauix 
kann auch als Jakobimatrix oder als Sensibilitatsmatrix be- 
zeichnet werden. 

Im Rahmen des Operation-Mode wird dann fur die Rege- 
lung der Vorhalteposition des Manipulators ein Ist-Mess- 
vektor ermittelt, d. h. es werden die Messdaten in der mo- 
menlanen Vorhalteposition des Manipulators des Handha- 
bungsgerats ermittelt und in dem Ist-Messvektor gespei- 
chert. Dann wird ein Differenzvektor aus der Differenz des 
Soll-Messvektors und des Ist-Messvektors gebildel. Des 
Weiteren wird der Kehrwert der Gradientenmauix berechnet 
und wahlweise abgespeichert. 

SchlieBlich wird ein Korrekturvektor aus der Multiplika- 
tion des Kehrwerts der Gradientenmatrix mit dem Diffe- 
renzvektor berechnet und die Vorhalteposition in Abhangig- 
keit von dem Korrekturvektor geregelt. 

Der Korrekturvektor kann auch mittels eines anderen ge- 
eigneten Verfahrens bestimmt werden, bspw. durch den Ein- 



satz eines sequentiellen Kalmanfilters. Derartige geeignete 
Verfahren zum Berechnen des Korrekturvektors sind aus 
dem Stand der Technik bekannt und konnen von einem 
Fachmann nach Belieben eingesetzt werden. Diese anderen 
geeigneten Verfahren haben den Vorteil, dass auf eine relativ 
aufwendige Bildung des Kehrwerts der Gradientenmauix 
verzichtet werden kann. 

Wahrend des Operation-Mode fahrt der Manipulator zu- 
nachst die Verfahrbahn gemaB den wahrend des Record- 
Mode gespeicherten Punkten ab. Diese Verfahrbahn wird 
dann im Rahmen der Regelung der Vorhalteposition des Ma- 
nipulators mit Hilfe des Korrekturvektors korrigiert. Bei 
dem erfindungsgemaBen Verfahren wird die Vorhaltepos- 
ition also nicht absolut, sondem lediglich relativ zu einer 
Vorhalteposition auf der gespeicherten Verfahrbahn gere- 
gelt. 

Vorleilhafterweise wird die Ist- Vorhalteposition im Rah- 
men der Regelung der Vorhalteposition um einen Bruchteil 
des Korrekturvektors korrigiert und anschlieBend der Ist- 
Messvektor in der korrigierten Ist- Vorhalteposition und dar- 
aus der Korrekturvektor emeut ermittelt. Die Ist- Vorhalt- 
eposition wird also nicht um den gesamlen Korrekturvektor 
korrigiert. Um ein Uberschwingen der Regelung zu verhin- 
dern, wird viehnehr versucht, sich der Soil- Vorhalteposition 
langsam von einer Richtung her anzunahem. Dadurch wird 
eine Regelung mit einem gedampften Einschwingverhalten 
realisiert. Durch eine geeignete Wahl des Bruchteils des 
Korrekturvektors kann die Dampfungskonstante der Rege- 
lung bestimmt werden. 

Die Regelung der Vorhalteposition wird vorzugsweise ab- 
gebrochen, wenn jedes der Elemente des Korrekturvektors 
kleiner als ein Abbruchkriterium ist, Durch eine geeignete 
Wahl des Abbruchkriteriums kann einerseits die Genauig- 
keit der Regelung und andererseits die Regelungsgeschwin- 
digkeit bestinunt werden. Je kleiner der Wert des Abbruch- 
kriteriums gewahlt wird, desto genauer kann die Regelung 
der Vorhalteposition durchgefiihrt werden. Ein kleiner Wert 
des Abbruchkriteriums bedeutet jedoch auch, dass die Rege- 
lung mehr Zeit benotigt, bis das Abbruchkriterium erfiilil 
ist. 

Um eine Regelbarkeit der Vorhalteposition des Manipula- 
tors innerhalb eines bestimmten Arbeitsvolumens der Rege- 
lung sicherzuslellen, sollten die aufgenonunenen Messvek- 
toren nach Moglichkeit das gesamte Arbeitsvolumen abdek- 
ken. Des Weiteren sollten fiir jeden Freiheitsgrad so viele 
Messvektoren aufgenommen werden, dass eine zuverlassige 
Berechnung des BeU-ags des Gradienten der Messdaten 
moglich ist. Deshaib wird gemaB einer bevorzugten Ausfuh- 
rungsform der Erfindung vorgeschlagen, dass fur jeden Frei- 
heitsgrad von der Soil- Vorhalteposition aus mindestens zwei 
Messvektoren in jede Richtung aufgenommen werden, Vor- 
teilhafterweise werden jedoch fiir jeden Freiheitsgrad von 
der Soil- Vorhalteposition aus fiinf Messvektoren in jede 
Richtung aufgenonunen. Somit ergeben sich fiir jeden Frei- 
heitsgrad zehn Messvektoren und der Soll-Messvektor, also 
elf Messvektoren. Fiir jedes der aufgenommenen und in den 
Messvektoren gespeicherte Messdatum wird dann der Be- 
U^g des Gradienten berechnet und in der Gradientenmauix 
abgespeichert. 

Die Messvektoren miissen zusammen fiir jeden Freiheits- 
grad, in dem die Vorhalteposition des Manipulators des 
Handhabungsgerats geregelt wird, mindestens ein unabhan- 
giges Messdatum enthalten. GemaB einer weiteren bevor- 
zugten Ausfuhrungsform der Erfindung wird vorgeschlagen, 
dass die Messvektoren zusanunen mindestens sechs Mess- 
daten enthalten. Dadurch kann die Position und Ausrichtung 
des Manipulators relativ zu dem Objekt in sechs Freiheits- 
graden eindeutig charakterisiert werden. Damit kann die 
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Vorhalteposition des Manipulators um sechs Freiheitsgrade 
im dreidimensionalen Raum geregelt werden. Vbrzugsweise 
enthalten die Messvekloren jeweils 32 Messdaten. 

Eine weitere Aufgabe der vorliegenden Erfindung besteht 
darin, eine Vorrichlung dereingangs genannten Art dahinge- 
hend auszugestalten und weiterzubilden, dass eine mog- 
lichst schnelle Regelung der Vorhalteposition erreichl und 
dass insbesondere hohere Verfahrgeschwindigkeiten des 
Manipulators auf der Verfahrbahn realisiert werden konnen, 
ohne dass es zu einem Verlust an Regelungsgenauigkeit 
kommt. 

Zur Losung dieser Aufgabe schlagt die Erfindung ausge- 
hend von der Vorrichtung der eingangs genannten Art vor, 
dass die Vorrichtung Mittel zur Durchfiihrung des Verfah- 
rens nach einem der Anspriiche 1 bis 13 aufweist, 

Eine weitere Aufgabe der vorliegenden Erfindung besteht 
schlieBlich darin, ein Handhabungsgerat der eingangs ge- 
nannten Art dahingehend auszugestalten und weiterzubil- 
den, dass eine moglichst schnelle Regelung der Vorhaltepos- 
ition erreicht und dass insbesondere hohere Verfahrge- 
schwindigkeiten des Manipulators auf der Verfahrbahn rea- 
lisiert werden konnen, ohne dass es zu einem Verlust an Re- 
gelungsgenauigkeit kommu 

Zur Losung dieser Aufgabe schlagt die Erfindung ausge- 
hend von dem Handhabungsgerat der eingangs genannten 
Art vor, dass das Handhabungsgerat Mittel zur Durchfiih- 
rung des Verfahrens nach einem der Anspriiche 1 bis 13 auf- 
weist. 

Die erfindungsgemaBe Vorrichtung und das erfindungsge- 
maBe Handhabungsgerat weisen insbesondere Mittel auf, 
um in einem Record-Mode mehrere Punkte zumindest eines 
Teils der 1st- Verfahrbahn zu speichem und die gespeicherten 
Punkte dann in einem Operation-Mode fur eine voraus- 
schauende Regelung der Vorhalteposition des Manipulators 
entlang dieses Teils der Verfahrbahn heranzuziehen. Des 
Weiteren weisen die erfindungsgemaBe Vorrichtung und das 
erfindungsgemaBe Handhabungsgerat Mittel auf, um in ei- 
nem Parameter-Mode ira Rahmen einer Trainingsphase den 
Manipulator in eine Soil- Vorhalteposition zu fahren, um den 
Manipulator um die einzelnen Freiheitsgrade des Handha- 
bungsgerats in andere Vorhaltepositionen zu verfahren und 
fiir jeden Freiheitsgrad in jeder Vorhalteposition die Mess- 
daten aufzunehmen und zu speichem, durch die die entspre- 
chende Vorhalteposition charakterisiert ist. 

Bei der erfindungsgemaBen Vorrichtung und dem erfin- 
dungsgemaBen Handhabungsgerat kann die Verfahrge- 
schwindigkeit des Manipulators aufgrund der vorausschau- 
enden Regelung besonders groB gewahlt werden. AuBerdem 
ersetzt die Trainingsphase das Einrichten und Kalibrieren 
der Sensoren. Mit der erfindungsgemaBen Vorrichtung und 
dem erfindungsgemaBen Handhabungsgerat ist somit eine 
schneUere Regelung der Vorhalteposition moglich, ohne 
dass es zu einem Verlust an Regelungsgenauigkeit kommt. 

GemaB einer vorteilhaften Weiterbildung der vorliegen- 
den Erfindung wird vorgeschlagen, dass an dem Manipula- 
tor des Handhabungsgerats zur Ermittlung der Ist- Vorhalt- 
eposition des Manipulators relativ zu dem Objekt minde- 
stens ein Sensor befestigt ist. 

Der Oder jeder Sensor ist vorteilhafterweise derarl relativ 
zu dem Objekt angeordnet, dass die Folge der Messdaten 
der fiir einen Freiheitsgrad aufgenommenen Messvektoren 
streng monoton ist. Dies ist eine wichtige Voraussetzung, 
um den Manipulator aus alien Positionen und Ausrichtun- 
gen relativ zu dem Objekt stets in die gewiinschte Soll-M)r- 
halteposition regeln zu konnen. 

Des Weiteren muss die Beobachtbarkeit der Regelung si- 
chergestellt sein. Deshalb wird gemaB einer anderen vorteil- 
haften Ausfiihrungsform der Erfindung vorgeschlagen, dass 



der Oder jeder Sensor derart relativ zu dem Objekt angeord- 
net ist, dass in der Gradienienmairix fiir jeden Freiheitsgrad 
jeweils fiir mindestens einen aufgenommenen Messdaten 
ein Gradienten-Betragswert enthalten ist. 

5 Damil die in der Gradientenmatrix im Rahmen der Rege- 
lung der Vorhalteposition auch verarbeitet werden konnen, 
und zu einem zuverlassigen Ergebnis fiihren, wird vorge- 
schlagen, dass der oder jeder Sensor derart relativ zu dem 
Objekt angeordnet ist, dass die Gradienten-Betragswerte in 

10 der Gradientenmatrix signifikant sind. Man spricht von si- 
gnifikanten Gradienten-Betragswerten, wenn diese von dem 
Messrauschen der aufgenommenen Messdaten unterscheid- 
bar sind. Die Gradienten-Betragswerte sind bspw. unter- 
scheidbar, wenn sie etwa doppeli so groB sind wie das Mess- 

15 rauschen der aufgenommenen Messdaten. Falls die Gra- 
dientenstarke nicht ausreichend groB ist, wird der entspre- 
chende Gradienten-Betragswert als nicht vorhanden gewer- 
tet. Die Gradienten-Betragswerte in der Gradientenmatrix 
sind vorzugsweise in etwa niindestens dreimal so groB wie 

20 das Messrauschen. 

Die Kriterien der Monotonie der Folge der Messdaten, 
der Beobachtbarkeit der Regelung und der Gradientenstarke 
konnen durch die Position der Sensoren relativ zu dem Ma- 
nipulator beeinflusst werden. Der genaue Bezug der Senso- 

25 ren zu dem Manipulator ist allerdings von unteigeordneter 
Bedeutung, solange die o. g. Kriterien erfiillt sind. Der Be- 
zug der Sensoren zu dem Manipulator wird wahrend der 
Trainingsphase erfasst und iiber die aufgenommenen und 
abgespeicherten Messdaten in der Regelung beriicksichtigt. 

30 GemaB einer bevorzugten Ausfiihrungsform der vorlie- 
genden Erfindung wird vorgeschlagen, dass der oder jeder 
Sensor als ein optischer Sensor, insbesondere als eine CCD- 
Kamera, ausgebildet ist. Mittels CG3-Kameras kann ein 
Objekt auf vielfallige Weise charakterisiert werden. Es ist 

35 denkbar, dass die Messdaten bei als CCD-Kameras ausge- 
bildeten Sensoren als Abstande zwischen den Sensoren und 
dem Objekt, als Pixel auf dem CCD-Chip o. a. ausgebildet 
sind. CCD-Kameras haben zudem den Vorieil, dass ihr 
Blickfeld zum Ausrichten der Sensoren relativ zu dem Ob- 

40 jekt auf einem Bildschirm dargestellt werden kann. Das er- 
leichtert die Ausrichtung der Sensoren erheblich. 

Ein bevorzugtes AusfUhrungsbeispiel der vorliegenden 
Erfindung wird im Folgenden anhand der Zeichnung naher 
erlautert. Es zeigt: 

45 Fig, 1 ein erfindungsgemaBes Handhabungsgerat gemaB 
einer bevorzugten Ausfuhrungsform; 

Fig. 2 den Manipulator des Handhabungsgerats aus Fig. 1 
im Ausschnitt; und 
Fig, 3 eine Verfahrbahn eines erfindungsgemaBen Hand- 

50 habungsgerats. 

In Fig, 1 ist ein erfindungsgemaBes Handhabungsgerat in 
seiner Gesamtheit mit dem Bezugszeichen 1 gekennzeich- 
net. Das Handhabungsgerat 1 weist einen Manipulator 2 auf, 
der in sechs Freiheitsgraden (x, y, z, a, b, c) bewegbar ist. 

55 Das Handhabungsgerat 1 ist bspw. als ein Industrie-Roboter 
ausgebildet, dessen Manipulator 2 bspw. als ein beliebiges 
Werkzeug oder als ein Messkopf zur Aufnahme beliebiger 
MessgroBen (Temperatur, Abstand, etc.) ausgebildet ist. 
Damit der Manipulator 2 die ihm zugedachte Aufgabe er- 

60 fiillen kann, muss er in eine definierte Vorhalteposition (vgl. 
Fig. 2) relativ zu einem Objekt 3 gebracht werden, Unter 
dem Begriff Vorhalteposition wird gemaB dem vorliegenden 
Patent auch die Ausrichtung des Manipulators 2 relativ zu 
dem Objekt 3 verstanden. Die Erfindung schlagt ein Verfah- 

65 ren zur Regelung der Vorhalteposition vor. Das erfindungs- 
gemaBe Verfahren kann nicht nur fiir jede Art von Pick-and- 
place-Anwendungen, sondem auch fiir Anwendungen, bei 
denen einem bestimmten Linienverlauf gefolgt werden 
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muss, bspw. zum SchweiBen. Kleben oder Abdichten von 
Kanien, eingeseizt werden. 

GemaB dem vorliegenden Ausfuhrungsbeispiel soil ein 
Schiebedach 4 eines Kraftfahrzeugs von dem Manipulator 2 
ergriffen und in eine enlspiechende Offnung (Objekt 3) im 
Dach 5 der Karosserie des Kraftfahrzeugs eingesetzl wer- 
den. Der Manipulator 2 ist als ein Saugnapf zum Greifen des 
Schiebedachs 4 ausgebildet. Die Vorhalteposition ist eine 
Position oberhalb der Offnung, von der aus das Schiebedach 
4 in einer geradlinigen, senkrechten Bewegung nach unten 
in die Offnung bewegt werden kann. 

Das Handhabungsgerat 1 weist eine interne Steuerungs- 
einrichtung 6 auf. Auf der Steuerungseinrichtung 6 ist ein 
Steuerungsprogramm lauffahig, durch das der Manipulator 
2 entlang einer programmierten Verfahrbahn (vgl. Fig. 3) in 
die Vorhalteposition bewegt werden kann. Wenn das Objekt 
3, im vorliegenden Ausfuhrungsbeispiel die Offnung im 
Dach 5 der Karosserie des Kraftfahrzeugs, stets an derselben 
Position angeordnet ist, reicht eine soiche Steuerung der 
Verfahrbahn bis zur Vorhalteposition vollkonunen aus. Falls 
die Position des Objekts 3 jedoch gewissen Schwankungen 
unterworfen ist, kann durch eine Steuerung alleine nicht 
mehr sichergestellt werden, dass eine bestimmte Vorhalt- 
eposition des Manipulators 2 relativ zu dem Objekt 3 stets 
mit der erforderlichen Genauigkeit eingenommen wird. 
Schwankungen des Objekts 3 konnen sich bspw. aufgrund 
von Ungenauigkeiten bei der Positionierung der Karosserie 
relativ zu dem Handhabungsgerat 1 oder aufgrund der Be- 
wegung der Karosserie des Kraftfahrzeugs auf einer Ferti- 
gungsstraBe ergeben. 

Um sicherzustellen, dass die Vorhalteposition des Mani- 
pulators 2 relativ zu dem Objekt 3 auch bei Schwankungen 
der Position des Objekts 3 stets mit der geforderten Genau- 
igkeit eingenommen wird, wird in solchen Fallen die Vor- 
halteposition des Manipulators 2 relativ zu dem Objekt 3 ge- 
regelt. Aus dem Stand der Technik sind mehrere Verfahren 
zur Regelung der Vorhalteposition des Manipulators 2 be- 
kannt. Diese Verfahren sind jedoch sehr arbeits- und zeitauf- 
wendig. 

Das erfindungsgemaBe Verfahren zur Regelung der Vor- 
halteposition des Manipulators 2 weist verschiedene Merk- 
male zur Beschleunigung und Vereinfachung der Regelung 
auf. Das Verfahren ist auf einer externen Regelungseinrich- 
tung 7 implementiert (vgl. Fig. 1). Die Regelungseinrich- 
tung 7 ist als ein herkommlicher Personal-Computer (PC) 
Oder Industrie-PC ausgebildet. Auf der Regelungseinrich- 
tung 7 ist ein Regelungsprogramm, das in einer herkommli- 
chen Programmiersprache programmierl ist, lauffahig. In 
Fig. 1 ist die Regelungseinrichtung 7 als von dem Handha- 
bungsgerat 1 getrennt ausgebildet. Es ist jedoch auch denk- 
bar, dass die Regelungseinrichtung 7 in das Handhabungs- 
gerat 1 integriert ist. Das Steuerungsprogramm der Steue- 
rungseinrichtung 6 ist in einer proprietaren, nur auf der 
Steuerungseinrichtung 6 dieses Handhabungsgerats 1 lauf- 
fahigen Programmiersprache programmiert. Das Steue- 
rungsprogramm weist an bestimmten Stellen Programmier- 
befehie (Aufrufbefehle, Riickholbefehle) auf, um das Rege- 
lungsprogramm der externen Regelungsvorrichtung 7 von 
dem Steuerungsprogramm aus aufeurufen bzw. um von dem 
Regelungsprogramm wieder zu dem Steuerungsprogramm 
zuruckzukehren. Zwischen der Steuerungseinrichtung 6 und 
der Regelungseinrichtung 7 ist eine Datenleitung 8 zum 
Austausch von Daten vorgesehen. 

In Fig. 2 ist zu erkennen, dass an dem Manipulator 2 vier 
als CCD-Kameras ausgebildete Sensoren 9 angeordnet sind. 
Durch die Sensoren 9 werden die Verlaufe der Kanten 10 in 
Relation zu dem Manipulator 2 gesetzt. Dazu werden Mess- 
daten, die im vorliegenden Ausfuhrungsbeispiel als Pixel- 



10 

werte der CCD-Chips der Sensoren 9 ausgebildet sind, auf- 
genommen und in Ivlessvekloren gcspeichert. 

Das erfindungsgemaBe Verfahren zur Regelung der Vor- 
halteposition des Manipulators 2 relativ zu dem Objekt 3 

5 weist drei unterschiedliche Betriebszustande auf. In einem 
ersten Betriebszustand, dem sog. Record-Mode, wird die 
Verfahrbahn A bis B (vgl. Fig, 3) zu einer Vorhalteposition 
hin und von der Vorhalteposition weg von dem Steuerungs- 
programm der Steuerungseinrichtung 6 gesteuert abgefah- 

10 ren. In dem Bereich der Verfahrbahn zwischen den Punkten 
C und D Liegt ein fiir die Regelung interessanter Bereich mit 
einem oder mehreren Vorhaltepositionen des Manipulators 
2, die relativ zu dem Objekt 3 geregelt werden sollen. Wenn 
der Manipulator 2 beim Abfahren der Verfahrbahn den 

15 Punkt C erreicht hat, wird das Regelungsprogramm der Re- 
gelungseinrichtung 7 aufgerufen. Wahrend des gesteuerten 
Abfahrens der Verfahrbahn von dem Punkt C bis D werden 
dann einer oder mehrere Punkte von dem Regelungspro- 
gramm aufgenommen und gespeichert. Wenn die Verfahr- 

20 bahn den Punkt D erreicht hat, wird das Regelungspro- 
gramm beendet Damil ist der Record-Mode beendet. Auf 
die gespeicherten Punkte der Verfahrbahn wird dann in ei- 
nem dritten Betriebszustand der Regelung zugegriffen. 
In einem zweiten Betriebszustand, dem sog. Parameter- 

25 Mode, fahn der Manipulator 2 von dem Steuerungspro- 
gramm gesteuert die Verfahrbahn von dem Punkt A zu dem 
Punkt C ab. Wenn die Verfahrbahn den Punkt C erreicht hat, 
wird das Regelungsprogramm aufgerufen, und die Steue- 
rung des Manipulators 2 wird von dem Steuerungspro- 

30 gramm an das Regelungsprogramm abgegeben. Das Rege- 
lungsprogramm fahrt die gespeicherte Verfahrbahn zwi- 
schen den Punkten C und D ab. Auf der Verfahrbahn werden 
diejenigen Vorhaltepositionen angefahren, die relativ zu 
dem Objekt geregelt werden sollen, und fur jede Vorhalt- 

35 eposition wird eine Trainingsphase durchlaufen. Wenn die 
von dem Regelungsprogramm gesteuerte Verfahrbahn den 
Punkt D erreicht hat, wird das Regelungsprogranmi beendet 
und die Steuerung des Manipulators 2 entlang der Verfahr- 
bahn wieder an das Steuerungsprogramm zuriickgegeben. 

40 Der Manipulator 2 fahrt dann von dem Steuerungspro- 
gramm gesteuert die restiiche Verfahrbahn von dem Punkt D 
bis B ab. Damit ist der Parameter-Mode beendet. 

Fiir jede Vorhalteposition, die relativ zu dem Objekt 3 ge- 
regelt werden soli, wird eine Trainingsphase durchgefiihrt. 

45 Dazu wird zunachst die Soil- Vorhalteposition mit dem Ma- 
nipulator 2 angefahren, und von den Sensoren 9 werden die 
Werte von 32 Messdaten, durch die die Soil- Vorhaltepos- 
ition charakterisiert ist, aufgenommen und in einem Soll- 
Messvektor y_soll gespeichert. Der Soll-Messvektor y_soll 

50 hat somit die Dimension 32 x 1 (32 Messdaten x 1 Wert). 
AnschlieBend wird der Manipulator 2 nacheinander um je- 
den der sechs Freiheitsgrade in fiinf Vorhaltepositionen in 
der einen Richtung der Soil- Vorhalteposition und in funf 
Vorhaltepositionen in der anderen Richtung der Soll-Vor- 

55 halteposition bewegt. In jeder Vorhalteposition werden die 
entsprechenden Werte der 32 Messdaten aufgenommen und 
in Messvektoren gespeichert. Aus den zehn Messvektoren 
und dem Soll-Messvektor y_soll wird dann fiir jeden der 
sechs Freiheitsgrade der Betrag des Gradienten eines be- 

60 stimmten Messdatums berechnet und in einer Gradienten- 
matrix C abgespeichert. Die Gradientenmalrix C hat somit 
die Dimension 32 x 6 (32 Messdaten x 6 Freiheitsgrade). 
Fiir jeden der zu regelnden Vorhaltepositionen erhalt man 
somit einen Soll-Messvektor y_soU und die Gradientenma- 

65 trixC. 

In einem dritten Beuiebszustand, dem sog. Operation- 
Mode, fahrt der Manipulator 2 von dem Steuerungspro- 
gramm gesteuert die Verfahrbahn von dem Punkt A zu dem 
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Punkt C ab. Wenn die Verfahrbahn den Punkt C erreicht hat, 
wird das Regelungsprogramm aufgerufen, und die Steue- 
rung des Manipulators 2 wird von dem Steuerungspro- 
gramm an das Regelungsprogramm abgegeben. Das Rege- 
lungsprogramm fahrt die gespeicherte Verfahrbahn zwi- 5 
schen den Punkten C und D ab. Die gespeicherten Punkie 
der Verfahrbahn erlauben eine vorausschauende Regelung 
der Vorhaliepunkte auf der Verfahrbahn, was bei gleicher 
Oder sogar hoherer Genauigkeit eine wesentlich hohere Ver- 
fahrbahngeschwindigkeit als bei den aus dem Stand der lO 
Technik bekannten Verfahren zum Regeln der Vorhaltepos- 
ition eines Manipulators ermoglicht. 

In dem Bereich der Verfahrbahn zwischen den Punkten E 
und F liegt ein fur die Regelung interessanter Bereich mil ei- 
nem oder mehreren Vorhaltepositionen des Manipulators 2, 15 
die relativ zu dem Objekt 3 geregelt werden soilen, Sobald 
die Verfahrbahn den Punkt E erreicht hat, erfolgl eine Rege- 
lung der Vorhalleposition auf der Verfahrbahn. Im Rahmen 
der Regelung der Vorhalteposition werden von den Senso- 
ren 9 zunachst in der momentanen 1st- Vorhalteposition die 20 
entsprechenden Werte der Messdaten aufgenommen und in 
einem Ist-Messvektor yjst gespeichert. Der Ist-Messvektor 
yjst hat ebenfalls die Dimension 32 x 1 (32 Messdaten x 1 
Wert). Aus der Differenz des Soll-Messvektors und des Ist- 
Messvektors wird ein Differenz-Messvektor D_y gebildet 25 
(D_y = y soli - yjst). Der Differenz-Messvektor D_y hat 
ebenfalls die Dimension 32 x 1. Dann wird der Kehrwert 
der Gradientenmatrix C berechnet und wahlweise abgespei- 
chert. Aus dem Produkt des Kehrwerts des Gradientenvek- 
tors C und des DifFerenz-Messvektors D_y wird ein Korrek- 30 
turvektor D_x ermittelt, der ebenfalls die Dimension 32 x 1 
hat. Es ist jedoch auch denkbar, dass der Korrekturvektor 
D_x mittels eines anderen geeigneten Verfahrens. bspw. 
durch den Einsatz eines sequentiellen Kalmanfilters, ermit- 
telt wird. 35 

Ein Teil des Korrekturvektors D_x, vorzugsweise etwa 
10% des Korrekturvektors D_x, wird zur Korrektur der Ist- 
Vorhalteposition des Manipulators 2 herangezogen. In der 
neuen Ist- Vorhalteposition werden emeut die entsprechen- 
den Werte der Messdaten aufgenommen und in einem Ist- 40 
Messvektor y_ist gespeichert. Wie oben bereits beschrieben 
wird emeut ein Korrekturvektor D_x berechnet und die Ist- 
Vorhalteposition in AbhSngigkeit von dem Korrekturvektor 
D_x korrigiert. Die Korrektur der Ist- Vorhalteposition wird 
so lange wiederholt, bis die einzelnen Werte des Korrektur- 45 
vektors D_x ein bestimmtes Abbruchkriterium erfiillt ha- 
ben, d. h. bis der Manipulator 2 auf die Soli- Vorhaltepos- 
ition geregelt ist. 

Palentanspriiche 50 

1. Verfahren zur Regelung der Vorhalteposition eines 
in mehreren Freiheitsgraden bewegbaren Manipulators 
(2) eines Handhabungsgerats (1) relativ zu einem Ob- 
jekt (3) entlang einer Verfahrbahn, dadurch gekenn- 55 
zeichnet, dass mehrere Punkte zumindest eines Teils 
der Ist- Verfahrbahn gespeichert sind und fur eine vor- 
ausschauende Regelung der Vorhalteposition des Ma- 
nipulators (2) entlang dieses Teils der Verfahrbahn her- 
angezogen werden. 60 

2. Verfahren nach Anspruch 1, dadurch gekennzeich- 
net, dass die Ist- Verfahrbahn des Manipulators (2) vor 
der Regelung der Vorhalteposition abgefahren wird 
und dabei die Punkte zumindest eines Teils der Ist- Ver- 
fahrbahn aufgenommen und abgespeichert werden. 6S 

3. Verfahren nach Anspruch 2, dadurch gekcnnzeich- 
net, dass die Ist- Verfahrbahn von dem Manipulator (2) 
vor der Regelung der Vorhalteposition von einer inter- 



nen Steuerungseinrichtung (6) des Handhabungsgerats 

(1) gesteuert abgefahren wird, 

4. Verfahren nach Anspruch 2 oder 3, dadurch gekenn- 
zeichnet, dass die Punkte zumindest eines Teils der Ist- 
Verfahrbahn von einer extemen Regelungseinrichtung 
(7) aufgenommen und abgespeichert werden. 

5. Verfahren nach Anspruch 3 und 4, dadurch gekenn- 
zeichnet, dass die exteme Regelungseinrichtung (7) 
von der intemen Steuerungseinrichtung (6) aufgerufen 
wird. 

6. Verfahren zur Regelung der Vorhalteposition eines 
in mehreren Freiheitsgraden bewegbaren Manipulators 

(2) eines Handhabungsgerats (1) relativ zu einem Ob- 
jekt (3) endang einer Verfahrbahn, insbesondere nach 
einem der Anspriiche 1 bis 5, dadurch gekennzeichnet, 
dass die Soli- Vorhalteposidon des Manipulators (2) vor 
der Regelung der Vorhalteposidon angefahren wird, 
wahrend einer Veranderung der Soli- Vorhalteposition 
um jeweils einen Freiheitsgrad Messdaten, durch die 
die Vorhalteposition des Manipulators (2) charakteri- 
siert ist, aufgenommen und gespeichert werden und die 
Regelung der Vorhalteposition in Abhangigkeit von 
den Messdaten durchgefuhrt wird. 

7. Verfahren nach Anspruch 6, dadurch gekennzeich- 
net, dass vor der Regelung der Vorhalteposition 

- die Soli- Vorhalteposition angefahren wird, 

- ein SoU-Messvektor (y_soll) mit den Messda- 
ten aufgenommen wird, 

- fiir jeden Freiheitsgrad der Manipulator (2) des 
Handhabungsgerats (1) aus der Soll-Vorhaltepos- 
ition heraus in mehrere Vorhaltepositionen be- 
wegt und in jeder Vorhalteposition ein Messvektor 
aufgenommen wird, 

- fur jeden Freiheitsgrad fLir dieselben Messdaten 
der Messvektoren der Beu-ag des Gradienten er- 
mittelt und in einer Gradientenmatrix (C) gespei- 
chert wird, und im Rahmen der Regelung der Vor- 
halteposition 

- ein Korrekturvektor (D_x) aus der Multiplika- 
tion des Kehrwerts der Gradientenmatrix (C) mit 
der Differenz des Soll-Messvektors (y_soll) und 
eines Ist-Mess vektors (yjst) in der Ist- Vorhalt- 
eposition des Manipulators (2) oder anhand eines 
anderen geeigneten Verfahrens ermittelt wird und 

- die Vorhalteposition in Abhangigkeit von dem 
Korrekturvektor (D_x) geregelt wird. 

8. Verfahren nach Anspruch 7, dadurch gekennzeich- 
net, dass die Ist- Vorhalteposition des Manipulators (2) 
im Rahmen der Regelung der Vorhalteposition um ei- 
nen Bruchteil des Korrekturvektors (D_x) korrigiert 
wird und anschlieSend der Ist-Messvektor (yjst) in der 
korrigierten Ist- Vorhalteposition und daraus der Kor- 
rekturvektor (D_x) emeut ermittelt wird. 

9. Verfahren nach Anspruch 8, dadurch gekennzeich- 
net, dass die Regelung der Vorhalteposition abgebro- 
chen wird, wenn jedes der Elemente des Korrekturvek- 
tors (D_x) kleiner als ein Abbruchkriterium ist. 

10. Verfahren nach Anspruch 8 oder 9, dadurch ge- 
kennzeichnet, dass fur jeden Freiheitsgrad von der 
Soil- Vorhalteposition aus mindestens zwei Messvekto- 
ren in jede Richtung aufgenommen werden. 

11. Verfahren nach Anspruch 10, dadurch gekenn- 
zeichnet, dass fiir jeden Freiheitsgrad von der Soli- Vor- 
halteposition aus funf Messvektoren in jede Richtung 
aufgenommen werden. 

12. Verfahren nach einem der Anspriiche 1 bis 5, da- 
durch gekennzeichnet, dass die Messvektoren zusam- 
men mindestens sechs Messdaten enthalten, damit die 
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Position und Ausrichlung des Manipulators (2) relativ 
zu dem Objekt (3) im dreidimensionalen Raum charak- 
lerisiert ist. 

13. Verfahren nach Anspruch 12. dadurch gekenn- 
zeichnet, dass die Mcssvektoren jeweils 32 Messdaten 5 
enthalten. 

14. Vorrichtung zur Regelung der Vorhalleposition ei- 
nes in mehreren Freiheitsgraden bewegbaren Manipu- 
lators (2) eines Handhabungsgerats (1) relativ zu einem 
Objekt (3) entlang einer Verfahrbahn, dadurch gekenn- lO 
zeichnel, dass die Vorrichtung Mittel zur Durchfuhrung 
des Verfahrens nach einenn der AnsprOche 1 bis 1 3 auf- 
weist. 

15. Handhabungsgeral (1) mit einem in mehreren Frei- 
heitsgraden bewegbaren Manipulator (2), dessen Vor- 15 
haileposilion relativ zu einem Objekt (3) regelbar ist, 
dadurch gekennzeichnet, dass das Handhabungsgeral 
(9) Mittel zur Durchfuhrung des Verfahrens nach ei- 
nem der Anspriiche 1 bis 13 aufweist. 

16. Handhabungsgeral (1) nach Anspruch 15, dadurch 20 
gekennzeichnet, dass an dem Manipulator (2) des 
Handhabungsgerats (1) zur Ermitilung der Ist- Vorhall- 
eposition des Manipulators (2) relativ zu dem Objekt 
(3) mindestens ein Sensor (9) befestigt ist. 

17. Handhabungsgeral (1) nach Anspruch 16, dadurch 25 
gekennzeichnet, dass der oder jeder Sensor (9) derart 
relativ zu dem Objekt (3) angeordnet ist, dass die Folge 
der Messdaten der fiir einen Freiheitsgrad aufgenom- 
menen Messvektoren streng monoton ist. 

18. Handhabungsgeral (1) nach Anspruch 17, dadurch 30 
gekennzeichnet, dass in der Gradientenmatrix (C) fiir 
jeden Freiheitsgrad jeweils fiir mindestens ein aufge- 
nommenes Messdatum ein Gradienten-Betragswert 
enthalten isl. 

19. Handhabungsgeral (1) nach Anspruch 18, dadurch 35 
gekennzeichnet, dass die Gradienten-Betragswerte in 
der Gradientenmatrix (C) signifikant sind. 

20. Handhabungsgeral (1) nach einem der Anspriiche 
15 bis 19, dadurch gekennzeichnet, dass der oder jeder 
Sensor (9) als ein optischer Sensor ausgebildet ist. 40 

21. Handhabungsgeral (1) nach Anspruch 20, dadurch 
gekennzeichnet, dass der oder jeder Sensor (9) als eine 
CGD-Kamera ausgebildet ist. 
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METHOD AND DEVICE FOR CONTROLLING THE INTERMEDIATE POSITION 
OF A MANIPULATOR OF A HANDLING DEVICE 

[0001] The present invention relates to a method and to a device for controlling the 
intermediate position' of a manipulator of a handling device that is movable in a plurality of 
degrees of freedom, relative to an object along a traverse path. The present invention also 
relates to a handling device having a manipulator that is movable in a plurality of degrees of 
freedom and whose intermediate position relative to an object is controllable. 

[0002] The handling device is designed, for example, as a multi-jointed industrial robot. 
Industrial robots of this kind are used, in particular, in the automotive industry, [specifically] 
in production and quality assurance. The manipulator can have any given design to 
accommodate the various possible applications of an industrial robot. 

[0003] The manipulator is designed, for example, as a tool, in particular as a welding 
device, as a device for applying adhesive, paint, or other coatings to a surface, as a processing 
device, or the like. The manipulator can be designed as a gripper, as a suction cup, or the like, 
for grasping one or more objects. Finally, it is conceivable for the manipulator to be designed 
as a sensing head, for example, for measuring the surface profile of an object, a gap width, a 
gap offset, a coating thickness, or the like. 

[0004] In order for the manipulator to perform its designated task, it is necessary to move 
it into a defined intermediate position relative to an object. In accordance with the present 
patent [sic. invention], intermediate position is understood to be both the positioning, as well 
as orientation of the manipulator relative to the object. 



' Translator's note: ^^Intermediate position'' was selected as the translation for "Vorhalteposition." 
Siemens refers to this as '^predicted position," in other words "the position reached by the robot if it 
moves with the selected velocity for the next time interval and then stops with maximal decelerations." 
Since this application speaks often of predictive control of the position," calling it ''predictive control of 
the predicted position'' would have been redundant. Other terms used in the literature include "limit 
point," "deceleration point," "anticipation point," "prestop," "ready position," and "forward limit 
position." 



[0005] From the related art, handling devices are known which have an internal open-loop 
control device. In response to an open-loop control program, which is executable on the open- 
loop control device, the manipulator can be moved along a programmed traverse path into the 
intermediate position. When the object is always located at the same position, this type of 
control of the traverse path up to the intermediate position suffices entirely. However, if the 
position of the object is subject to certain fluctuations, as is normally the case, it is no longer 
possible to ensure, alone by an open-loop control, that a defined intermediate position of the 
manipulator relative to the object will always be able to be assumed with the requisite 
precision. There can be many different causes of fluctuations in the position of the object. 

[0006] To ensure that the intermediate position of the manipulator relative to the object is 
always assumed with the requisite precision, even in the case of positional fluctuations of the 
object, it is likewise known from the related art to control the intermediate position of the 
manipulator relative to the object. Different methods for controlling the intermediate position 
of the manipulator are known from the related art. However, these known methods for 
controlling the intermediate position are very complicated and slow. 

[0007] In the course of controlling the intermediate position of the manipulator relative to 
an object, the actual intermediate position of the manipulator is initially recorded by sensors 
and then controlled to a setpoint intermediate position. The sensors are designed, for example, 
as optical or as tactile sensors. 

10008] In particular, they are designed as laser sensors for measuring distances, as 
force/moment sensors for measuring forces or moments, or as contact sensors for detecting a 
contacting of the object. 

[0009] The sensors are arranged in a specific relation (position and orientation) to the 
manipulator. Before the control of the intermediate position is carried out, the sensors must be 
brought into a specific relation with the manipulator and the object (set up), and the 
parameters of the control must be adapted to the specific relation (calibration). The relation 
between the sensors and the manipulator can change due to temperature fluctuations, 
mechanical actions on the sensors or the manipulator, or the like, thereby necessitating a 
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repeated calibration and possibly even a repeated setting up of the device for implementing 
the control. During set-up and calibration, the device is not available for a control; the process 
of controlling the intermediate position must be interrupted. 

[0010] Moreover, all of the known methods for controlling the intermediate position of 
the manipulator have the disadvantage that the traversing velocity of the manipulator is 
relatively low, since the control is carried out without knowledge of the manipulator traverse 
path to be controlled that lies ahead. For that reason, the traversing velocity must be selected 
to be low enough to ensure a rapid and precise positioning of the manipulator, even in the 
extreme case of a reversal in the traversing direction. A too-high traversing velocity in the 
context of highly curved traverse paths or a reversal in the traversing direction would cause 
the manipulator to overshoot the controlled traverse path and thereby leave the same. 

[0011] It is, therefore, an object of the present invention to develop and further refine a 
method of the type mentioned at the outset in a way that will enable a fastest possible control 

of the intermediate position to be achieved and, in particular, higher traversing velocities of 
the manipulator on the traverse path to be realized, without incurring any loss of control 
precision. 

[0012] To achieve this objective, starting out fi-om the method of the type mentioned at 
the outset, the present invention provides that a plurality of points of at least one portion of 
the actual traverse path be stored, and that a predictive control of the intermediate position of 
the manipulator along this portion of the traverse path be consulted. 

[00131 It has been discovered in accordance with the present invention that, through the 
use of a predictive control, it is possible to substantially accelerate the control of the 
intermediate position in a simple manner. The configuration of the traverse path that lies 
ahead is considered during the predictive control of the intermediate position. When 
permitted by the configuration of the traverse path that lies ahead, for example when working 
with a straight or an only slightly curved traverse path, a high traversing velocity may be 
selected for the manipulator. This makes it possible to substantially accelerate the control of 
the intermediate position along a traverse path. In the case of increasing curvature of the 
traverse path that lies ahead, it is necessary to increasingly reduce the traversing velocity. In 
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addition, by selecting a low traversing velocity when working with pronoimced cxxrvatures of 
the upcoming traverse path, it is possible to signficantly enhance the accuracy of the control 
of the manipulator's intermediate position along the traverse path. Thus, in accordance with 
the method of the present invention, the traversing velocity may be individually adapted to the 
configuration of the traverse path that lies ahead. 

[0014] The points of the actual traverse path may be determined in different ways, for 
example empirically, through simulation, or by calculation. When the points of the actual 
traverse path are determined empirically, the individual points may be approached by the 
manipulator of the handling device either manually or in a process controlled by a first open- 
loop control device. When the points are determined through simulation, a model of the 
handling device and of the object is first generated, preferably on a computer. On the basis of 
this model, the actual traverse path is then determined by simulating the traverse path. When 
the points of the actual traverse path are computed mathematically, a mathematical model of 
the handling device and of the object is first generated; and the points are then computed by 
solving mathematical equations. 

100151 hi accordance with one advantageous embodiment of the present invention, the 
actual traverse path of the manipulator is traveled prior to the process of controlling the 
intermediate position and, in the process, the points of at least one portion of the actual 
traverse path are recorded and stored. There is no need for stringent demands to be placed on 
precision when traveling [covering] the actual traverse path, since the traverse path may be 
corrected during the subsequent control of the traverse path of the manipulator. The traveled 
actual traverse path merely represents an estimation of the configuration of the setpoint 
traverse path and must be accurate enough to be used for a predictive control of the 
manipulator's intermediate position along the traverse path. 

[00161 The actual traverse path is advantageously traveled in a controlled process by the 
manipulator before the intermediate position is controlled by an internal open-loop control 
device of the handling device. An open-loop control program, in which the individual points 
of the actual traverse path are programmed, is executed on the internal open-loop control 
device. The handling device is driven by the open-loop control program in such a way that, 
during execution thereof, the manipulator travels the actual traverse path. In the process, the 



4 



points of at least one portion of the actual traverse path are recorded and stored. Apart from 
the points of the actual traverse path programmed in the open-loop control program, 
additional points of the actual traverse path may be recorded and stored. 

[0017] The points of at least one portion of the actual traverse path are preferably recorded 
and stored by an external closed-loop control device. A closed-loop control program, which 
controls the intermediate position of the manipulator on the traverse path, is executed on the 
external closed-loop control device. The external closed-loop control device is designed, for 
example, as a personal computer (PC) or as an industrial personal computer. The closed-loop 
control program may be programmed in a standard programming language and be 
reprogrammed without entailing substantial outlay. Before controlling the intermediate 
position, the closed-loop control program may also record and store the points of the actual 
traverse path traveled by the manipulator, in one specific mode (record mode). The stored 
points are then consulted in another mode (operation mode) for the predictive control of the 
intermediate position. 

[00181 Another advantageous embodiment of the present invention provides for the 
external closed-loop control device to be invoked by the internal open-loop control device. 
The open-loop control program of the internal open-loop control device is typically 
programmed in a proprietary programming language that is only executable on the open-loop 
control device of a specific handling device. Considerable outlay would have to be expended 
to integrate the entire closed-loop control program into the open-loop control program. For 
that reason, specific programming instructions (invocation instructions, return instructions) 
are provided in the open-loop control program, in order to invoke the closed-loop control 
program of the external closed-loop control device from the open-loop control program.^ 
Little outlay is needed to insert these programming instructions into the open-loop control 
program. Depending on the mode in which the control is operated, by invoking the closed- 
loop control program of the closed-loop control device, the points of the actual traverse path 
are recorded and stored (record mode), or the intermediate position is predictively controlled 
(operation mode). 



^ Translator's note: This sentence should perhaps include "or to return again from the closed-loop control 
program to the open-loop control program" as stated in paragraph 0056. 
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[0019] In accordance with another advantageous embodiment of the present invention, 
prior to control of the intermediate position, the setpoint intermediate position of the 
manipulator is approached; measurement data characterizing the intermediate position of the 
manipulator are collected and stored while the setpoint intermediate position is changed in 
each instance by one degree of freedom; and the intermediate position is controlled as a 
function of the measurement data. A correlation exists between the collected measurement 
data and the position of the manipulator. Thus, information pertaining to the position of the 
manipulator is contained in the collected measurement data. 

[0020] In another mode (parameter mode), the setpoint intermediate position is 
approached prior to control of the intermediate position. To approach the setpoint 
intermediate position in the parameter mode, the points of the actual traverse path stored in 
the record mode are consulted. As soon as the setpoint intermediate position is reached, a 
training phase begins, in which information required for the later control of the intermediate 
position carried out within the context of the operation mode, is ascertained. 

[0021] During the training phase, the manipulator is moved by the setpoint intermediate 
position, in each case by one degree of freedom, into different intermediate positions relative 
to the object. The manipulator is moved by each degree of freedom into intermediate 
positions that preferably reside on both sides of the setpoint intermediate position. The 
intermediate positions of the manipulator are ascertained by sensors which are preferably 
affixed to the manipulator. The sensors supply measurement data, on whose basis an 
intermediate position of the manipulator is characterized. The measurement data include, for 
example, the distances from the sensors to the object, [and] forces or moments exerted by the 
object on the sensors. The measurement data may also be photogrammetric data. 
Photogrammetric data are collected by measuring images that were captured by a CCD 
camera or the like. In the course of the training phase, the measurement data are collected for 
each of the degrees of freedom for each of the intermediate positions. It is conceivable for the 
stored measurement data to be further processed for the control of the intermediate position. 
The training phase for this setpoint intermediate position is then concluded. The manipulator 
may approach another setpoint intermediate position and run through another training phase 
for this setpoint intermediate position imtil all setpoint intermediate positions have been 
approached. The parameter mode is then complete. The later control of the intermediate 
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position performed in the context of the operation mode is carried out as a function of the 
stored measurement data. 

[0022] In the method according to the present invention, the training phase replaces the 
requisite set-up (positioning of the sensors relative to the object) and calibration (setting the 
parameters of the control) processes typical of conventional methods known from the related 
art for controlling the intermediate position of the manipulator of a handling device. 

[0023] In this method as well, in which a training phase is executed prior to controlling of 
the intermediate position, a plurality of points of at least one portion of the actual traverse 
path are stored and are consulted for a predictive control of the intermediate position of the 
manipulator along this portion of the traverse path. However, the process of executing a 
training phase prior to control of the intermediate position is associated with the advantages 
indicated, even without these features of the characterizing part of claim 1. Therefore, the 
protection of the patent [sic. the protection sought] should also relate to a method of the last 
mentioned type, in which the features set forth in the characterizing part of claim 1 are 
missing. 

[0024] In accordance with one preferred specific embodiment of the present invention, 
prior to controlling of the intermediate position: 

- the setpoint intermediate position is approached; 

- a setpoint measurement vector is recorded using the measurement data; 

- for each degree of freedom, the manipulator of the handling device is moved out of the 
setpoint intermediate position into a plurality of intermediate positions, and a measurement 
vector is recorded in each intermediate position; 

- for each degree of freedom, the absolute value of the gradient is determined for the same 
measurement data of the measurement vectors and is stored in a gradient matrix; and, in the 
course of the control of the intermediate position, 

- a correction vector is determined by multiplying the inverse value of the gradient matrix by 
the difference between the setpoint measurement vector and an actual measurement vector in 
the actual intermediate position of the manipulator or on the basis of another suitable method; 
and 

- the intermediate position is controlled as a function of the correction vector. 
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[0025) In accordance with this preferred specific embodiment, in the training phase in the 
parameter mode, the measurement data collected for the setpoint intermediate position are 
stored in a setpoint measurement vector, and the measurement data that were recorded for 
intermediate positions approached in the course of the training phase, are stored in 
measurement vectors. Thus, for each degree of freedom by which the manipulator is movable, 
a plurality of intermediate positions are approached from the setpoint intermediate position in 
each direction, and a measurement vector is recorded in each intermediate position. The 
dimension of the measurement vectors corresponds to the number of measurement data 
recorded for each intermediate position. The dimension of all measxirement vectors is equal in 
magnitude. 

[0026] The measurement vectors and the setpoint measurement vector are then further 
processed for each degree of freedom. From the same measurement data of the measurement 
vectors of one degree of freedom, the absolute value of the gradient is ascertained and stored 
in a gradient matrix. Thus, the gradient matrix has the dimensions (number of the 
measurement data recorded for each intermediate position) x (number of the degrees of 
freedom). It is conceivable to compute and store the inverse value of the gradient matrix 
already in the parameter mode. Preferably, however, it is first calculated in the subsequent 
operation mode. This concludes the training phase for this setpoint intermediate position. The 
gradient matrix may also be termed Jacobi matrix or sensitivity matrix. 

[0027) In the course of the operation mode, an actual measurement vector is then 
ascertained for the control of the intermediate position of the manipulator, i.e., the 
measurement data are determined in the instananeous intermediate position of the 
manipulator of the handling device and stored in the actual measurement vector. A 
differential vector is then formed from the difference between the setpoint measurement 
vector and the actual measiu-ement vector. In addition, the inverse value of the gradient 
matrix is computed and optionally stored. 

[0028] Finally, a correction vector is computed from the multiplication of the inverse 
value of the gradient matrix by the differential vector, and the intermediate position is 
controlled as a function of the correction vector. 
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[0029] The correction vector may also be determined using another suitable method, for 
example by using a sequential Kalman filter. Suitable methods of this kind for calculating the 
correction vector are known from the related art and can be used by one skilled in the art in 
any desired manner. The advantage of these other suitable methods is that the need is 
eliminated for the relatively complex process of forming the inverse value of the gradient 
matrix. 

[0030] During the operation mode, the manipulator first travels the traverse path in 
accordance with the points stored during the record mode. This traverse path is then corrected 
in the course of the control of the intermediate position of the manipulator with the aid of the 
correction vector. Thus, in accordance with the method of the present invention, the control 
of the intermediate position is not absolute; rather, it is merely relative to an intermediate 
position on the stored traverse path. 

[0031] The actual intermediate position is advantageously corrected in the course of the 
control of the intermediate position by a fraction of the correction vector, and the actual 
measurement vector in the corrected actual intermediate position and the correction vector 
derived therefrom, are ascertained once more. Thus, the actual intermediate position is not 
corrected by the entire correction vector. To prevent overshooting of the control, the attempt 
is made rather to approach the setpoint intermediate position slowly from one direction. This 
results in a control having a damped transient response. By suitably selecting the fraction of 
the correction vector, it is possible to determine the damping constant of the control. 

[0032] The control of the intermediate position is preferably discontinued when each of 
the elements of the correction vector is smaller than an abort criterion. By properly selecting 
the abort criterion, it is possible to determine the precision of the control on the one hand, and 
the control speed on the other hand. The smaller the value of the abort criterion is selected, 
the more precisely the control of the intermediate position may be implemented. However, a 
small value of the abort criterion also signifies that the control requires more time until the 
abort criterion is met. 

[0033] To ensure a controllability of the intermediate position of the manipulator within a 
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specific work volume of the control, the recorded measurement vectors should cover the 
entire work volume to the extent possible. In addition, for each degree of freedom, it is 
necessary to record as many measurement vectors as needed to make possible a reliable 
computation of the absolute value of the gradient of the measurement data. Therefore, one 
preferred specific embodiment of the present invention provides for at least two measurement 
vectors to be recorded in each direction for each degree of freedom, from the setpoint 
intermediate position. It is advantageous, however, for each degree of freedom, for five 
measurement vectors to be recorded in each direction, from the setpoint intermediate position. 
Thus, for each degree of freedom, ten measurement vectors and the setpoint measurement 
vector, thus eleven measurement vectors are derived. For each measuring datum that is 
recorded and stored in the measurement vectors, the absolute value of the gradient is 
computed and stored in the gradient matrix. 

[0034] For each degree of freedom in which the intermediate position of the manipulator 
of the handling device is controlled, the measurement vectors, together, must contain at least 
one independent measuring datum. Another preferred specific embodiment of the present 
invention provides for the measurement vectors, together, to contain at least six measurement 
data. This makes it possible for the position and orientation of the manipulator relative to the 
object to be uniquely characterized in six degrees of freedom. As a result, the intermediate 
position of the manipulator may be controlled by six degrees of freedom in three-dimensional 
space. The measurement vectors preferably each contain 32 measurement data. 

[0035] Another object of the present invention is to develop and further refine a device of 
the type mentioned at the outset in a way that will enable a fastest possible control of the 
intermediate position to be achieved and, in particular, higher traversing velocities of the 
manipulator on the traverse path to be realized, without incurring any loss of control 
precision. 

[0036] To achieve this objective, starting out from the device of the type mentioned at the 
outset, the present invention provides that the device have means for implementing the 
method according to one of the claims 1 through 13. 

[0037] Finally, another object of the present invention is to develop and further refine a 
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handling device of the type mentioned at the outset in a way that will enable a fastest possible 
control of the intermediate position to be achieved and, in particular, higher traversing 
velocities of the manipulator on the traverse path to be realized, without incurring any loss of 
control precision. 

[0038] To achieve this objective, starting out from the device of the type mentioned at the 
outset, the present invention provides that the handling device have means for implementing 
the method according to one of the claims 1 through 13. 

(0039) The device according to the present invention and the handling device according to 
the present invention have, in particular, means in order, in a record mode, to store a plurality 
of points of at least one portion of the actual traverse path and then, in an operation mode, to 
consult the stored points for a predictive control of the intermediate position of the 
manipulator along this portion of the traverse path. In addition, the device according to the 
present invention and the handling device according to the present invention have means in 
order, in a parameter mode, to drive the manipulator into a setpoint intermediate position; in 
the course of a training phase, to move the manipulator by the individual degrees of freedom 
of the handling device into other intermediate positions; and, for each degree of freedom, to 
record and store the measurement data in each intermediate position, thereby characterizing 
the corresponding intermediate position. 

[0040] In the case of the device according to the present invention and the handling device 
according to the present invention, the predictive control allows an especially high traversing 
velocity to be selected for the manipulator. Moreover, the training phase replaces the 
processes of setting up and calibrating the sensors. Thus, the device according to the present 
invention and the handling device according to the present invention make possible a more 
rapid control of the intermediate position, without incurring any loss of control precision. 

[0041] One advantageous embodiment of the present invention provides for at least one 
sensor to be affixed to the manipulator of the handling device to ascertain the actual 
intermediate position of the manipulator relative to the object. 

(0042] The or each sensor is advantageously positioned relative to the object in such a 
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way that the sequence of the measurement data of the measurement vectors recorded for one 
degree of freedom is strictly monotonic. This important condition must be met to always 
allow the manipulator to be controlled from all positions and orientations relative to the 
object into the desired setpoint intermediate position. 

[0043] In addition, the observability of the control must be ensured. For that reason, 
another advantageous specific embodiment of the present invention provides for the or each 
sensor to be positioned relative to the object in such a way that one absolute gradient value is 
contained in the gradient matrix for each degree of freedom, in each instance for at least one 
recorded measurement datum. 

[0044] To enable the [sic. WORD MISSING - absolute gradient values?] in the 
gradient matrix to also be processed in the course of controlling the intermediate position and 
to lead to a reliable result, it is provided that the or each sensor be positioned relative to the 
object in such a way that the absolute gradient values in the gradient matrix are significant. 
One speaks of significant absolute gradient values when they are distinguishable from the 
measurement noise of the collected measurement data. The absolute gradient values are 
distinguishable, for example, when they are approximately twice as great as the measurement 
noise of the recorded measurement data. In the case that the gradient magnitude does not 
suffice, the absolute gradient value in question is interpreted as non-existent. The absolute 
gradient values in the gradient matrix are preferably approximately at least three times as 
great as the measurement noise. 

[0045] The criteria of monotony of the sequence of the measurement data, of observability 
of the control, and of gradient magnitude may be influenced by the position of the sensors 
relative to the manipulator. However, the precise relation of the sensors to the manipulator is 
of secondary importance, as long as the criteria mentioned above are fiilfilled. The relation of 
the sensors to the manipulator is detected during the training phase and considered in the 
control as a function of the recorded and stored measurement data. 

[0046] One preferred specific embodiment of the present invention provides for the or 
each sensor to be designed as an optical sensor, in particular as a CCD camera. One object 
may be characterized in numerous ways through the use of CCD cameras. When working 
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with sensors designed as CCD cameras, it is conceivable that the measurement data be 
constituted as distances between the sensors and the object, as pixels on the CCD chip or the 
like. In addition, CCD cameras have the advantage that their field of view can be displayed on 
a screen, when aligning the sensors relative to the object. This substantially facilitates the 
process of aligning the sensors. 

[0047] One preferred exemplary embodiment of the present invention is described in more 
detail below with reference to the drawings, in which: 

[0048] FIG. 1 : shows a handling device according to the present in accordance with 
one preferred specific embodiment; 

[0049) FIG. 2: the manipulator of the handling device of FIG. 1 , in a detail view; and 

[0050] FIG. 3: a traverse path of a handling device according to the present invention, 

[00511 In FIG. 1, a handling device according to the present invention is denoted in its 
entirety by reference numeral 1 . Handling device 1 has a manipulator 2, which is movable in 
six degrees of fi-eedom (x, y, z, a, b, c). Handling device 1 is designed, for example, as an 
industrial robot whose manipulator 2 is designed, for example, as any given tool or as a 
sensing head for recording any given measured quantities (temperature, distance, etc.), 

[0052) In order for manipulator 2 to perform its designated task, it must be moved to a 
defined intermediate position relative to an object 3 (compare FIG. 2). In accordance with the 
present patent [sic. invention], intermediate position is understood to also include the 
orientation of manipulator 2 relative to object 3. The present invention provides a method for 
controlling the intermediate position. The method according to the present invention is not 
only suited for all types of pick-and-place applications, but also for applications in which a 
defined linear sequence must be followed, such as for welding, bonding or sealing of edges. 



[0053] In accordance with the present exemplary embodiment, a sunroof 4 of a motor 
vehicle is to be grasped by manipulator 2 and inserted in a corresponding opening (object 3) 
in roof 5 of the body of the motor vehicle. Manipulator 2 is designed as a suction cup for 
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grasping sunroof 4. The intermediate position is a position above the opening from where 
runroof 4 may be moved in a rectilinear, vertical motion downwards into the opening. 

[0054] Handling device 1 has an internal open-loop control device 6. In response to an 
open-loop control program, which is executable on open-loop control device 6, manipulator 2 
may be moved along a programmed traverse path (compare FIG. 3) into the intermediate 
position. When object 3, in the present exemplary embodiment, the opening in roof 5 of the 
motor vehicle body, is always located at the same position, such a control of the traverse path 
up to the intermediate position suffices entirely. However, if the position of object 3 is subject 
to certain fluctuations, it is no longer possible to ensure, alone through the use of an open- 
loop control, that a defined intermediate position of manipulator 2 relative to object 3 will 
always able to be assumed with the necessary precision. Fluctuations of object 3 may arise, 
for example, as the result of inaccuracies during positioning of the body relative to handUng 
device 1 or due to motion of the body of the motor vehicle on a production line. 

[0055] To ensure that the intermediate position of manipulator 2 relative to object 3 is 
always assumed with the necessary precision, even in the case of fluctuations of the position 
of object 3, in such cases, the intermediate position of manipulator 2 relative to object 3 is 
controlled in closed loop. Several methods for controlling the intermediate position of 
manipulator 2 in closed loop are known from the related art. However, these methods are very 
labor-intensive and time-consuming. 

[0056] The method according to the present invention for the closed-loop control of the 
intermediate position of manipulator 2 includes various features for accelerating and 
simplifying the closed-loop control. The method is implemented on an external closed-loop 
control device 7 (compare FIG. 1). Closed-loop control device 7 is designed as a conventional 
personal computer (PC) or as an industrial personal computer. A closed-loop control 
program, which is programmed in a conventional progranaming language, is executable on 
control device 7, In FIG. 1, closed-loop control device 7 is configured separately from 
handling device 1 . It is also conceivable, however, for closed-loop control device 7 to be 
integrated in handling device 1 . The open-loop control program of open-loop control device 6 
is programmed in a proprietary progranuning language that is only executable on open-loop 
control device 6 of this handling device 1 . At certain locations, the open-loop control program 
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has programming instructions (invocation instructions, return instructions), to invoke the 
closed-loop control program of external closed-loop control device 7 from the open-loop 
control program or to return again from the closed-loop control program to the open-loop 
control program. A data line 8 for exchanging data is provided between open-loop control 
device 6 and closed-loop control device 7, 

[0057] In FIG. 2, it is discernible that four sensors 9 designed as CCD cameras are 
mounted on manipulator 2. Sensors 9 are used to establish a relation between the form of 
edges 10 and manipulator 2. To that end, measurement data, which in the present exemplary 
embodiment are constituted as pixel values of the CCD chips of sensors 9, are collected and 
stored in measurement vectors. 

[0058] The method according to the present invention for controlling the intermediate 
position of manipulator 2 relative to object 3 features three different operating states. In a first 
operating state, the so-called record mode, traverse path A through B (compare FIG. 3) is 
traveled under open-loop control by open-loop control program of open-loop control device 6 
towards an intermediate position and away from the intermediate position. Located in the area 
of the traverse path between points C and D is a region of interest for the closed-loop control 
that includes one or more intermediate positions of manipulator 2, which are to be controlled 
in closed-loop relative to object 3. In response to manipulator 2 reaching point C as it travels 
the traverse path, the closed-loop control program of closed-loop control device 7 is invoked. 
While the traverse path is traveled in open-loop control from point C through D, one or more 
points are then recorded and stored by the closed-loop control program. When the traverse 
path has reached point D, the closed-loop control program is ended. This ends the record 
mode. The stored points of the traverse path are then accessed in a third operating state of the 
closed-loop control. 

[0059] In a second operating state, the so-called parameter mode, manipulator 2 travels 
the traverse path from point A to point C under control of the open-loop control program. 
When the traverse path has reached point C, the closed-loop control program is invoked, and 
the open-loop control program cedes control of manipulator 2 to the closed-loop control 
program. The closed-loop control program travels the stored traverse path between points C 
and D. On the traverse path, those intermediate positions are approached which are to be 



15 



controlled in closed-loop relative to the object, and a training phase is executed for each 
intermediate position. When the traverse path controlled by the closed-loop control program 
has reached point D, the closed-loop control program is ended, and the control of manipulator 
2 along the traverse path is again returned to the open-loop control program. Manipulator 2 
then travels the remaining traverse path from point D through B under control of the open- 
loop control program. This ends the parameter mode. 

[0060] A training phase is executed for each intermediate position which is to be 
controlled in closed loop relative to object 3. To that end, the setpoint intermediate position is 
first approached by manipulator 2, and the values of 32 measurement data which characterize 
the setpoint intermediate position, are recorded by sensors 9 and stored in a setpoint 
measurement vector y_setpoint. Thus, setpoint measurement vector y_setpoint has the 
dimension 32 x 1 (32 measurement data x 1 value). Manipulator 2 is subsequently moved by 
each of the six degrees of freedom, one after another, into five intermediate positions in the 
one direction of the setpoint intermediate position and into five intermediate positions in the 
other direction of the setpoint intermediate position. In each intermediate position, the 
corresponding values of the 32 measurement data are recorded and stored in measurement 
vectors. From the ten measurement vectors and setpoint measurement vector y_setpoint, the 
absolute value of the gradient of a specific measurement datum is then computed for 
each of the six degrees of freedom and is stored in a gradient matrix C. Thus, gradient 
matrix C has the dimension 32 x 6 (32 measurement data x 6 degrees of freedom). Thus, 
for each of the intermediate positions to be controlled in closed loop, one obtains a setpoint 
measurement vector y_setpoint and gradient matrix C. 

[00611 ^ a third operating state, the so-called operation mode, manipulator 2 travels the 
traverse path from point A to point C under control of the closed-loop control program. When 
the traverse path has reached point C, the closed-loop control program is invoked, and the 
open-loop control program cedes control of manipulator 2 to the closed-loop control program. 
The closed-loop control program travels the stored traverse path between points C and D. The 
stored points of the traverse path permit a predictive control of the intermediate positions on 
the traverse path, which, given the same or even greater precision, renders possible a 
substantially higher traverse-path velocity than do related-art methods for controlling the 
intermediate position of a manipulator. 
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[0062] Located in the area of the traverse path between points E and F is a region of 
interest for the closed-loop control that includes one or more intermediate positions of 
manipulator 2, which are to be controlled in closed-loop relative to object 3. As soon as the 
traverse path reaches point E, the intermediate position is controlled in closed loop on the 
traverse path. In the course of the closed-loop control of the intermediate position, the 
corresponding values of the measurement data are initially recorded by sensors 9 in the 
instantaneous actual intermediate position and stored in an actual measurement vector 
y_actuaL The actual measurement vector y actual likewise has the dimension 32x1 (32 
measurement data x 1 value). From the difference between the setpoint measurement vector 
and the actual measurement vector, a differential measurement vector D_y is formed (D_y = 
y setpoint - y_actual). Differential measurement vector D_y likewise has the dimension 32 x 
1 . The inverse value of gradient matrix C is then computed and optionally stored. From the 
product of the inverse value of gradient vector C and of differential measurement vector D_y, 
a correction vector D_x is ascertained, which likewise has the dimension 32 x 1 . It is also 
conceivable, however, for correction vector D_x to be ascertained using another suitable 
method, for example by employing a sequential Kalman filter. 

[0063] A portion of correction vector D_x, preferably about 10% of correction vector 
D_x, is used for correcting the actual intermediate position of manipulator 2. In the new 
actual intermediate position, the corresponding values of the measurement data are once again 
recorded and stored in an actual measurement vector y_actual. As already described above, a 
correction vector D_x is once again computed, and the actual intermediate position is 
corrected as a fimction of correction vector D_x. The process of correcting the actual 
intermediate position is repeated until the individual values of correction vector D_x have 
fulfilled a specific abort criterion, i.e., until manipulator 2 is controlled in closed loop to 
the setpoint intermediate position. 
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WHAT IS CLAIMED IS: 



1 . A method for controlling the intermediate position of a manipulator (2) of a handling 
device (1) that is movable in a plurality of degrees of freedom, relative to an object (3) 
along a traverse path, 

wherein a plurality of points of at least one portion of the actual traverse path are 
stored and are consulted for a predictive control of the intermediate position of the 
manipulator (2) along this portion of the traverse path, 

2. The method as recited in claim 1 , 

wherein the actual traverse path of the manipulator (2) is traveled prior to the process 
of controlling the intermediate position and, in the process, the points of at least one 
portion of the actual traverse path are recorded and stored. 

3. The method as recited in claim 2, 

wherein the actual traverse path is traveled by the manipulator (2) in a controlled 
process before the intermediate position is controlled by an internal open-loop control 
device (6) of the handling device (1). 

4. The method as recited in claim 2 or 3, 

wherein the points of at least one portion of the actual traverse path are recorded and 
stored by an external closed-loop control device (7). 

5. The method as recited in claims 3 and 4, 

wherein the external closed-loop control device (7) is invoked by the internal open- 
loop control device (6). 

6. The method for controlling the intermediate position of a manipulator (2) of a 
handling device (1) that is movable in a plurality of degrees of freedom, relative to an 
object (3) along a traverse path, in particular as recited in one of claims 1 through 5, 
wherein, prior to control of the intermediate position, the setpoint intermediate 
position of the manipulator (2) is approached, while the setpoint intermediate position 
is changed in each instance by one degree of freedom; measurement data 
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characterizing the intermediate position of the manipulator (2) are collected and 
stored; and the intermediate position is controlled as a function of the measurement 
data. 

7. The method as recited in claim 6, 

wherein, prior to the control of the intermediate position: 

- the setpoint intermediate position is approached; 

- a setpoint measurement vector (y_setpoint) is recorded using the measurement data; 

- for each degree of freedom, the manipulator (2) of handling device (1) is moved out 
of the setpoint intermediate position into a plurality of intermediate positions, and a 
measurement vector is recorded in each intermediate position; 

- for each degree of freedom, the absolute value of the gradient is determined for the 
same measurement data of the measurement vectors and is stored in a gradient matrix 
(C), and, in the course of the control of the intermediate position, 

- a correction vector (D_x) is determined by multiplying the inverse value of the 
gradient matrix (C) by the difference between the setpoint measurement vector 

(y setpoint) and an actual measurement vector (y actual) in the actual intermediate 
position of the manipulator (2) or on the basis of another suitable method; and 

- the intermediate position is controlled as a function of the correction vector (D_x). 

8. The method as recited in claim 7, 

wherein the actual intermediate position of the manipulator (2) is corrected in the 
course of the control of the intermediate position by a fraction of the correction vector 
(D_x), and the actual measurement vector (y actual) in the corrected actual 
intermediate position and the correction vector (D_x) derived therefrom, are 
ascertained once more. 

9. The method as recited in claim 8, 

wherein the control of the intermediate position is discontinued when each of the 
elements of the correction vector (D_x) is smaller than an abort criterion. 

10. The method as recited in claim 8 or 9, 

wherein, for each degree of freedom, at least two measurement vectors are recorded in 
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each direction, from the setpoint intermediate position. 



1 1 . The method as recited in claim 1 0, 

wherein, for each degree of freedom, five measurement vectors are recorded in each 
direction, from the setpoint intermediate position. 

12. The method as recited in one of claims 1 through 5, 

wherein, together, the measurement vectors contain at least six measurement data, in 
order that the position and orientation of the manipulator (2) relative to the object (3) 
be characterized in three-dimensional space. 

13. The method as recited in claim 12, 

wherein the measurement vectors each contain 32 measurement data. 

14. A device for controlling the intermediate position of a manipulator (2) of a handling 
device (1) that is movable in a plurality of degress of freedom, relative to an object (3) 
along a traverse path, 

wherein the device includes means for implementing the method as recited in one of 
the claims 1 through 13. 

15. A handling device (1) having a manipulator (2) that is movable in a plurality of 
degrees of freedom and whose intermediate position relative to an object (3) is 
controllable, 

wherein the handling device (9) includes means for implementing the method as 
recited in one of the claims 1 through 13. 



16. The handling device (1) as recited in claim 1 5, 

wherein at least one sensor (9) is affixed to the manipulator (2) of the handling device 
(1) to ascertain the actual intermediate position of the manipulator (2) relative to the 
object (3). 



17. The handling device (1) as recited in claim 16, 

wherein the or each sensor (9) is positioned relative to the object (3) in such a way 
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that the sequence of the measurement data of the measurement vectors recorded for 
one degree of freedom is strictly monotonic. 

The handling device (1) as recited in claim 17, 

wherein one absolute gradient value is contained in the gradient matrix (C) for each 
degree of freedom, in each instance for at least one recorded measurement datum. 

The handling device (1) as recited in claim 18, 

wherein the absolute gradient values in the gradient matrix (C) are significant. 

The handling device (1) as recited in one of claims 15 through 19, 
wherein the or each sensor (9) is designed as an optical sensor. 

The handling device (1) as recited in claim 20, 

wherein the or each sensor (9) is designed as a CCD camera. 
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ABSTRACT 



A method for controlling the intermediate position of a manipulator (2) of a handling device 
(1) that is movable in a plurality of degrees of freedom, relative to an object (3) along a 
traverse path. To make possible a more rapid control of the intermediate position, it is 
provided for a plurality of points of at least one portion of the actual traverse path to be stored 
and for a predictive control of the intermediate position of the manipulator (2) along this 
portion of the traverse path to be consulted. 
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